home
***
CD-ROM
|
disk
|
FTP
|
other
***
search
/
FM Towns: Free Software Collection 8
/
FM Towns Free Software Collection 8.iso
/
t_os
/
artemis
/
artsrc2
/
imath.h
< prev
next >
Wrap
C/C++ Source or Header
|
1994-06-01
|
8KB
|
195 lines
/*************************************************************************
imath.h
固定小数演算に関する宣言
math2.h, decimal.h, vector.h をまとめたもの
*************************************************************************/
extern int isqrt(int); // 固定小数の平方根(メチャ速い) by MAT (TSG)
/*--------------------------------------------------------*/
/* math2.h */
/*--------------------------------------------------------*/
/*
* math.h の補助 ver 0.3
*/
#define sign( a ) ( ( (a)>0 ) ? (1) : ( ((a)<0)?(-1):(0) ) )
#define max( a, b ) ( ( (a) > (b) ) ? (a) : (b) )
#define min( a, b ) ( ( (a) < (b) ) ? (a) : (b) )
#undef ads
// #define abs( a ) ( ( (a) > 0 ) ? (a) : (-(a)) )
#define DECIMAL 10 /* これは下位の 10bit shift の意味。 したがって本当の単位は 2^10。 整数部 2^22。 */
#define DUNIT 1024 /* = 2^10 */
/* 整数固定少数変換 */
#define IntToDeci( i ) ( (i) << DECIMAL )
#define DeciToInt( d ) ( (d) >> DECIMAL )
/* 固定少数の演算の補正 Macro。 (まとてやったほうが速いから別にしておく) */
#define AdjMulDeci( d ) ( (d) >> DECIMAL )
#define AdjDivDeci( d ) ( (d) << DECIMAL )
#define MulDeci( a, b ) ( (a)*(b) >> DECIMAL )
#define DivDeci( a, b ) ( ((a) << DECIMAL) /(b) )
/*--------------------------------------------------------*/
/* decimal.h */
/*--------------------------------------------------------*/
/*
* 10bit固定小数演算 v. 1.0
* math.h を仮定する。
*/
/*
* x, y は固定少数に限定するよう, 注意して使う。
* 足し算, 引き算はそのまま。 dummy で作ってもいいかもしれない。
*/
#define multi( x, y ) ( (x) * (y) >> DECIMAL )
#define div( x, y ) ( (x) / (y) << DECIMAL )
/*
* int multi( int x, int y ) { return x*y >> DECIMAL ;}
* int div (int x,int y) { return x/y << DECIMAL ;}
*/
extern int powd( int, int ) ;
/*
* 小さい変数のための三角関数( 小さくマクローリン展開しただけ。 べきの展開の大きさは個別に tune せよ。)
* 返り値も固定少数表現の整数である。 (COS for Small Decimal)
*/
#define cossd( x ) ( DUNIT - powd( (x), 2 )/2 + powd( (x), 4 )/24 - powd( (x), 6 )/720 )
#define sinsd( x ) ( (x) - powd( (x), 3 )/6 + powd( (x), 5 )/120 - powd( (x), 7)/5040 )
/*
* 三角数列。 そのまま cos, sin の関数とみなす。
*/
#if 0
extern int cos512[1024];
extern int sin512[1024];
extern int acos512[2048+1];
extern int asin512[2048+1];
#define cos512( x ) (cos512[x])
#define sin512( x ) (sin512[x])
#define acos512( x ) (acos512[(x)+DUNIT])
#define asin512( x ) (asin512[(x)+DUNIT])
#endif
/* -DUNIT は負に対応するため, 数列は原点をずらして持っている。 */
/*--------------------------------------------------------*/
/* vector.h */
/*--------------------------------------------------------*/
/*
* Vector演算関数 ver 1.12
*
* math.h, math2.h を仮定する。
*/
/*
* 型宣言
*/
struct vect2i { int x ; int y }; /* 二次元整数vector */
struct vect3i { int x ; int y ; int z }; /* 三次元整数vector */
struct vect3p { int x; int y ; int z }; /* 三次元固定少数vector */
struct vect3f { float x ; float y ; float z }; /* 三次元浮動少数vector */
struct matrix3i { int xx ; int xy ; int xz ;
int yx ; int yy ; int yz ;
int zx ; int zy ; int zz ; }; /* 3×3整数行列 */
struct matrix3p { int xx ; int xy ; int xz ;
int yx ; int yy ; int yz ;
int zx ; int zy ; int zz ; }; /* 3×3固定少数行列 */
struct surfi {
struct vect3i norl; /* 法線 (NORmal Line) */
struct vect3i s0; /* 面上の一点 */
int c; /* 定数 */
};
struct surfp {
struct vect3p norl; /* 法線 (NORmal Line) */
struct vect3p s0; /* 面上の一点 */
int c; /* 固定少数の定数 */
};
/*
* 固定少数整数変換関数
*/
extern struct vect3i DeciToInt3V( struct vect3p p );
extern struct vect3p IntToDeci3V( struct vect3i p );
extern struct matrix3i DeciToInt3M( struct matrix3p A );
extern struct matrix3p IntToDeci3M( struct matrix3i A );
/*
* vector 演算関数
*/
#define MakeZero2i( p ) { (p).x=0; (p).y=0; }
#define MakeZero2p( p ) { (p).x=0; (p).y=0; }
extern struct vect2i scalar2i( int, struct vect2i ) ;
extern struct vect2i inscalar2i( int, struct vect2i );
extern struct vect2i scalar2p( int, struct vect2i );
extern struct vect2i add2i( struct vect2i, struct vect2i );
extern struct vect2i subtr2i( struct vect2i, struct vect2i );
extern struct vect2i rshift2i( struct vect2i, int );
extern struct vect2i lshift2i( struct vect2i, int );
#define iszero2( p ) ( (p).x==0 && (p).y==0 )
#define abs2i( p ) ( (int)sqrt( (p).x*(p).x + (p).y*(p).y ) )
#define innerpro2i( p, q ) ( (p).x*(q).x + (p).y*(q).y )
#define innerpro2p( p, q ) AdjMulDeci( (p).x*(q).x + (p).y*(q).y )
#define issame2v( p, q ) ( (p).x==(q).x && (p).y==(q).y )
#define MakeZero3i( p ) { (p).x=0; (p).y=0; (p).z=0; }
#define MakeZero3p( p ) { (p).x=0; (p).y=0; (p).z=0; }
extern struct vect3i scalar3i( int, struct vect3i );
extern struct vect3i scalar3p( int, struct vect3i );
extern struct vect3i inscalar3i( int, struct vect3i );
extern struct vect3i add3i( struct vect3i, struct vect3i );
extern struct vect3p add3p( struct vect3p x1, struct vect3p x2 );
extern struct vect3i subtr3i( struct vect3i, struct vect3i );
extern struct vect3p subtr3p( struct vect3p x1, struct vect3p x2 );
extern struct vect3i outerpro3i( struct vect3i, struct vect3i );
extern struct vect3p outerpro3p( struct vect3p x1, struct vect3p x2 );
extern struct vect3i rshift3i( struct vect3i p, int i );
extern struct vect3i lshift3i( struct vect3i p, int i );
extern struct vect3p rshift3p( struct vect3p p, int i );
extern struct vect3p lshift3p( struct vect3p p, int i );
#define issame3v( p, q ) ( (p).x==(q).x && (p).y==(q).y && (p).z==(q).z )
#define ispara3( p, q ) ( ( (p).x*(q).y - (p).y*(q).x )==0 && ( (p).x*(q).z - (p).z*(q).x )==0 && ( (p).y*(q).z - (p).z*(q).y )==0 )
#define iszero3( p ) ( (p).x==0 && (p).y==0 && (p).z==0 )
#define det3( p, q, r ) ( (p).x*(q).y*(r).z + (q).x*(r).y*(p).z + (r).x*(p).y*(q).z - (p).x*(r).y*(q).z - (q).x*(p).y*(r).z - (r).x*(q).y*(p).z )
#define innerpro3i( p, q ) ( (p).x*(q).x + (p).y*(q).y + (p).z*(q).z )
#define innerpro3p( p, q ) AdjMulDeci( (p).x*(q).x + (p).y*(q).y + (p).z*(q).z )
#define abs3i( p ) ( (int)sqrt( (p).x*(p).x + (p).y*(p).y + (p).z*(p).z ) )
#define Normalize3i( p ) { if( abs3i(p)>0 ) (p)=inscalar3i( abs3i(p) ,scalar3i( DUNIT, (p) ) );}
/* p の大きさをdunitにする */
#define cos3i( p, q ) ( (innerpro3i( p, q ) << DECIMAL) / abs3i(p) / abs3i(q) )
/* p, q のなす角の cos を固定少数で返す */
#define Init3V( p ) { (p).x=0 ; (p).y=0 ; (p).z=0 ;}
/*
* 行列演算関数
*/
extern struct matrix3i addm3i( struct matrix3i A, struct matrix3i B );
#define addm3p( A, B ) ( addm3i( (A), (B) ) )
extern struct matrix3i subm3i( struct matrix3i A, struct matrix3i B );
#define subm3p( A, B ) ( subm3i( (A), (B) ) )
extern struct matrix3i mulmm3i( struct matrix3i A, struct matrix3i B );
extern struct matrix3p mulmm3p( struct matrix3p A, struct matrix3p B );
extern struct vect3i mulmv3i( struct matrix3i A, struct vect3i p );
extern struct vect3p mulmv3p( struct matrix3p A, struct vect3p p );
extern struct vect3i mulmv3pi( struct matrix3p A, struct vect3i p );
/* 3次元vectorの回転 */
extern struct vect3i RotXi( int a, struct vect3i p );
extern struct vect3p RotXp( int a, struct vect3p p );
extern struct vect3i RotYi( int a, struct vect3i p );
extern struct vect3p RotYp( int a, struct vect3p p );
extern struct vect3i RotZi( int a, struct vect3i p );
extern struct vect3p RotZp( int a, struct vect3p p );
extern struct matrix3p RotX( int a );
extern struct matrix3p RotY( int a );
extern struct matrix3p RotZ( int a );
#define Init3M( A ) { (A).xx=0 ; (A).xy=0 ; (A).xz=0 ; (A).yx=0 ; (A).yy=0 ; (A).yz=0 ; (A).zx=0 ; (A).zy=0 ; (A).zz=0 ; }
/* 平面を表す関数 */
#define surffi( s, p ) ( innerpro3i( (s).norl, (p) ) - (s).c )
#define surffp( s, p ) ( innerpro3p( (s).norl, (p) ) - (s).c )
/* end of imath.h */